PR Type

• New Feature

Description

This PR introduces software-based FoV limits and early publishing for Hesai sensors.

Software-based FoV

Previously, configuring cloud_min_angle and cloud_max_angle would set the sensor's hardware filter to those values.
However, the hardware filter is using raw azimuths.
This lead to the scan having jagged edges (points missing in some channels, too many points in others).
For certain models, this affected areas of up to ~10deg on both edges of the FoV.

This PR improves upon this in the following way:

1. User sets cloud_min_angle and cloud_max_angle to the exact FoV they want the output pointcloud to have
2. Nebula retrieves sensor calibration file and computes appropriately over-sized* hardware-FoV
3. Nebula sends hardware-FoV to sensor (or validates it if setup_sensor == false)
4. The Nebula decoder cuts the scan at the exact edges defined via the parameters above

Early publishing

Previously, a scan was published once the packet after it was received. This was done because this made the scan completion check easier (could compare 2 azimuths according to some scan completion criterion).
For scans of 360deg, this is not a problem, as there is no time gap between the end of one scan and the beginning of the next.
However, for FoVs < 360deg, this approach increases latency unnecessarily: for an FoV of 180deg and 1 full rotation every 100ms, the additional latency of the finished pointcloud just "sitting there" is 50ms.

This PR improves upon this in the following way:

1. Swap the order of decoding and scan completion check: decode first, then check for completion
2. Check if the current packet completed the current scan, as opposed to whether the current packet is the first belonging to the next scan

Other

For testing this PR with AT128, I had to fix the LidarRange issue:

• fixes AT128 HW interface crashes on GetLidarRange #129

This was done by checking the sensor model before sending the LidarRange command.

Review Procedure

Check for the following FoVs

• 0 - 360 deg
• 90 - 270 deg
• 270 - 90 deg
  if the pointcloud in Rviz has clean edges at those angles for a 360 deg sensor such as OT128.

Check AT128 in the same way but with FoVs inside [30; 150].

Remarks

These two improvements have been combined into one PR as they are closely related and would require extra work to function independently.

Pre-Review Checklist for the PR Author

PR Author should check the checkboxes below when creating the PR.

• Assign PR to reviewer

Checklist for the PR Reviewer

Reviewers should check the checkboxes below before approval.

• Commits are properly organized and messages are according to the guideline
• (Optional) Unit tests have been written for new behavior
• PR title describes the changes

Post-Review Checklist for the PR Author

PR Author should check the checkboxes below before merging.

• All open points are addressed and tracked via issues or tickets

CI Checks

• Build and test for PR: Required to pass before the merge.